from gopigo import *
import sys, time

delaytime = 1

time.sleep(delaytime)
fwd()
time.sleep(delaytime)
stop()
time.sleep(delaytime)
bwd()
time.sleep(delaytime)
stop()
time.sleep(delaytime)
left()
time.sleep(delaytime)
stop()
time.sleep(delaytime)
right()
time.sleep(delaytime)
stop()
cmdist = us_dist(15)
print "%i cm" % cmdist
